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Abstract 

Unmanned  Aerial  Vehicles  (UAVs)  have  attracted  significant 
attentions  in  recent  years  due  to  their  potentials  in  various 
military  and  civilian  applications.  Small  UAVs  are  often  e- 
quipped  with  low-cost  and  lightweight  micro-electro-mechan¬ 
ical  systems  (MEMS)  inertial  measurement  units  including 
3-axis  gyro,  accelerometer  and  magnetometer.  The  measure¬ 
ments  provided  by  gyros  and  accelerometers  often  suffer  from 
bias  and  excessive  noise  as  a  result  of  temperature  variations, 
vibration,  etc.  This  paper  presents  a  sensor  fault  diagnostic 
method  for  quadrotor  UAVs.  Specifically,  we  consider  the 
faults  in  the  gyro  and  accelerometer.  A  model-based  sensor 
fault  detection  and  isolation  (FDI)  estimation  method  is  pre¬ 
sented.  The  proposed  FDI  method  adopts  the  idea  that  ac¬ 
celerometer  and  gyroscopic  measurements  coincide  with  the 
translational  and  rotational  forces  represented  in  the  UAV  dy¬ 
namics.  Thus,  the  faults  in  accelerometer  and  gyroscope  can 
be  represented  as  virtual  actuator  faults  in  the  quadrotor  state 
equations.  Two  diagnostic  estimators  are  designed  to  provide 
structured  FDI  residuals  allowing  simultaneous  detection  and 
isolation  of  gyroscope  and  accelerometer  sensor  bias.  In  ad¬ 
dition,  nonlinear  adaptive  estimators  are  designed  to  provide 
an  estimate  of  the  unknown  sensor  bias.  The  parameter  con¬ 
vergence  property  of  the  adaptive  estimation  scheme  is  an¬ 
alyzed.  Simulation  studies  utilizing  a  nonlinear  quadrotor 
UAV  model  are  used  to  illustrate  the  effectiveness  of  the  pro¬ 
posed  method. 

1.  Introduction 

Unmanned  Aerial  Vehicles  (UAVs)  have  attracted  significant 
attentions  in  recent  years  due  to  their  potentials  in  various 
military  and  civilian  applications,  including  security  patrol, 
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search  and  rescue  in  hazardous  environment,  surveillance  and 
classification,  attack  and  rendezvous  (Shima  &  Rasmussen, 
2008).  In  addition,  compared  with  manned  systems,  the  re¬ 
ductions  in  operations  and  support  costs  for  unmanned  vehi¬ 
cles  offer  the  advantage  for  life  cycle  cost  savings  (US  Dept, 
of  Defense,  2012).  The  potential  capabilities  offered  by  un¬ 
manned  vehicles  have  been  well  recognized  and  continue  to 
expand.  In  manned  systems,  the  human  operator  functions 
as  the  central  integrator  of  the  onboard  systems  to  achieve 
their  operational  capabilities.  Due  to  the  requirement  of  au¬ 
tonomous  operations  without  a  human  operator,  autonomous 
control  of  UAVs  is  much  more  challenging.  For  instance, 
UAVs  currently  suffer  mishaps  at  10  to  100  times  the  rate 
incurred  by  their  manned  counterparts  (US  Dept,  of  Defense, 
2012,  2000).  In  order  to  enhance  the  reliability,  survivabil¬ 
ity  and  autonomy  of  UAVs,  advanced  intelligent  control  and 
health  management  technologies  are  required,  which  will  en¬ 
able  UAVs  to  have  the  capabilities  of  state  awareness  and  self¬ 
adaptation  (Sharifi,  Mirzaei,  Gordon,  &  Zhang,  2010;  Vacht- 
sevanos,  Tang,  Drozeski,  &  Gutierrez,  2005). 

Most  quadrotors  used  in  research,  are  often  equipped  with 
low-cost  and  lightweight  micro-electro-mechanical  systems 
(MEMS)  inertial  measurement  units  (IMU)  including  3-axis 
gyro,  accelerometer  and  magnetometer.  These  sensors  serve 
an  essential  role  in  most  quadrotor  control  schemes.  How¬ 
ever,  due  to  their  intrinsic  components  and  fabrication  pro¬ 
cess,  IMUs  are  vulnerable  to  exogenous  signals  and  prone  to 
faults.  Specifically,  accelerometer  and  gyroscope  measure¬ 
ments  are  susceptible  to  bias  and  excessive  noise  as  a  result 
of  temperature  variation,  vibration,  etc.  The  detection  and 
estimation  of  accelerometer  and  gyroscope  faults  plays  a  cru¬ 
cial  role  in  the  safe  operations  of  quadrotors. 

Several  researchers  have  investigated  the  problem  of  quadro¬ 
tor  IMU  sensor  fault  diagnosis  based  on  linearized  quadrotor 
dynamic  model  (Sharifi  et  al.,  2010;  Freddi,  Fonghi,  &  Mon- 
teriu,  2009;  Dydek,  Annaswamy,  &  Favretsky,  2013;  Here- 
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Figure  1.  Quadrotor  Model  in  ”+”  configuration. 


dia,  Ollero,  Mahtani,  &  Bejar,  2005).  A  few  papers  have  con¬ 
sidered  the  Luenberger  or  Kalman  filter  based  observers  in 
order  to  generate  residuals  for  fault  diagnosis  purposes  (see, 
for  example  (Freddi  et  al.,  2009;  Heredia  et  al.,  2005;  Lan- 
tos  &  Marton,  2011)).  These  methods  rely  on  linearization 
of  the  system  around  a  set  of  equilibrium  points.  However, 
the  dynamics  of  the  quadrotor  are  highly  nonlinear  and  the 
states  can  be  strongly  coupled.  In  recent  years,  considerable 
research  effort  has  been  devoted  to  fault  diagnosis  of  non¬ 
linear  systems  under  various  kinds  of  assumptions  and  fault 


sham,  2004;  Bangura  &  Mahony,  2012)  have  aimed  for  higher 
modeling  accuracy  by  including  drag  force,  Coriolis  effects, 
blade  flapping  effects  etc.  Accurate  modeling  plays  an  impor¬ 
tant  role  in  quadrotor  control,  especially  in  the  case  of  aggres¬ 
sive  maneuvers,  tight  group  formations,  etc.  However,  when 
the  quadrotor  is  in  a  non-aggressive  maneuver  state,  these  ef¬ 
fects  become  very  small  in  comparison  to  gravitational  pull 
and  thrust  generated  by  the  rotors.  As  in  (Leishman,  Jr., 
Beard,  &  McLain,  2014)  and  (Martin  &  Salaiin,  2010),  the 
dynamic  model  used  in  this  paper  considers  the  gravity,  thrust 
generated  by  the  rotors  and  drag  forces  acting  on  the  quadro¬ 
tor  body.  Figure  1  shows  a  simplifed  model  of  the  quadro¬ 
tor  along  with  the  assumed  body  frame  orientation  and  Euler 
angles  convention  using  the  right-hand  rule.  The  quadrotor 
nominal  system  dynamics  are  derived  from  the  Newton-Euler 
equations  of  motion  and  are  given  by: 
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scenarios  (Blanke,  Kinnaert,  Lunze,  &  Staroswiecki,  2005). 

In  this  paper  we  present  a  nonlinear  method  for  detecting, 
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the  fact  that  the  accelerometer  and  the  gyroscope  measure 
forces/torque  acting  directly  on  the  UAV  body,  the  quadro¬ 
tor  dynamics  are  expressed  in  terms  of  the  IMU  sensor  mea¬ 
surements.  Two  diagnostic  estimators  are  designed  to  pro¬ 
vide  structured  fault  detection  and  isolation  (FDI)  residuals 
allowing  simultaneous  detection  and  isolation  of  gyroscope 
and  accelerometer  sensor  bias.  In  addition,  by  utilizing  non¬ 
linear  adaptive  estimation  techniques  (Zhang,  Polycarpou,  & 
Parsini,  2001),  adaptive  estimators  are  employed  to  provide 
an  estimate  of  the  unknown  sensor  bias.  The  parameter  con¬ 
vergence  property  of  the  adaptive  estimation  scheme  is  ana¬ 
lyzed. 

The  remainder  of  the  paper  is  organized  as  follows.  Sec¬ 
tion  II  formulates  the  problem  of  sensor  FDI  for  quadrotor 
UAVs.  The  proposed  fault  detection  and  isolation  method  is 
presented  in  Section  III.  Section  IV  describes  the  adaptive  es¬ 
timator  algorithms  for  estimation  of  sensor  bias  magnitude 
and  provides  conditions  for  parameter  convergence.  Section 
V  and  VI  present  simulation  results  and  direction  of  future 
research,  respectively. 

2.  Problem  Formulation 

Several  works  focus  on  quadrotor  modeling  see  for  example 
(Bramwell,  Done,  &  Balmford,  2001)  and  (Castillo,  Lozano, 
&  Dzul,  2005).  More  recently,  (Pounds,  Mahony,  &  Gre¬ 


where  pE  E  M3  is  the  inertial  position,  vE  E  M3  is  the  ve¬ 
locity  expressed  in  the  Earth  frame,  g  =  [0,  'ip]T  E  M3 
are  the  roll,  pitch  and  yaw  Euler  angles,  respectively,  and 
uj  =  [pqr]T  represents  the  angular  rates,  m  is  the  mass  of 
the  quadrotor,  and  g  is  the  gravitational  acceleration.  The 
terms  Jx ,  Jy  and  Jz  represent  the  quadrotor  inertias  about  the 
body  x-,  y-  and  z-axis,  respectively.  Note  that  the  quadrotor 
is  assumed  to  be  symmetric  about  the  xz  and  yz  planes  (i.e. 
the  product  of  inertias  is  zero).  T  represents  the  total  thrust 
generated  by  the  rotors,  r^,  r#,  are  the  torques  acting  on 
the  quadrotor  around  the  body  x-,  y-  and  z-axis,  respectively. 
The  term  c&vE  represents  the  drag  force  acting  on  the  vehi¬ 
cle  frame,  with  Cd  being  drag  force  coefficient  and  vE  is  the 
velocity  of  the  UAV  relative  to  the  body  frame. 

The  system  model  described  by  Eq  (1)  -  (4)  is  expressed  with 
the  velocity  relative  to  the  inertial  frame.  The  inertial  coor¬ 
dinate  system  is  assumed  to  have  the  positive  x-axis  pointing 
North,  the  positive  y-axis  pointing  East  and  positive  z-axis 
pointing  down  towards  the  Earth’s  center.  The  transforma¬ 
tion  from  the  body  frame  to  inertial  frame  is  given  by  the 
rotation  matrix  REE  and  is  defined  based  on  a  3-2-1  rotation 
sequence  as  follows: 
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Reb{v) 


c9cp  scpsOcip  —  cpsp  cps9cip  +  spsp 
c9sp  sps9sp  +  cpcp  cps9sp  —  spcp 
— s9  spc9  ccpcO 


where  s-  and  c*  are  short  hand  notations  for  the  sin(-)  and 
cos(-)  functions,  respectively. 

MEMS  sensors,  such  as  accelerometers  and  gyroscopes,  mea¬ 
sure  forces  and  moments  acting  in  the  body  frame.  The  quan¬ 
tity  expressed  inside  the  parenthesis  in  the  inertial  velocity 
Eq.  (2),  represents  all  the  forces  acting  on  the  body.  There¬ 
fore,  the  velocity  dynamic  equation  can  be  adjusted  to  reflect 
accelerometer  measurements.  Similarly,  the  evolution  of  Eu¬ 
ler  angles  can  be  rewritten  in  terms  of  gyroscope  measure¬ 
ments  (Leishman  et  al.,  2014;  Ireland  &  Anderson,  2012). 
By  considering  IMU  measurement  susceptibility  to  a  constant 
bias  drift,  the  accelerometer  and  gyroscope  sensor  measure¬ 
ments  are  given  by: 
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where  ya  G  M3  and  yu  G  M3  are  the  measured  accelerome¬ 
ter  and  gyro  quantities,  respectively,  ba  G  M3  and  G  M3 
are  the  possible  constant  bias  in  accelerometer  and  gyroscope 
measurements,  respectively,  and  a  represents  the  nominal  ac¬ 
celeration  measurement  without  bias,  that  is: 


In  addition,  as  in  (Ireland  &  Anderson,  2012)  and  (Lantos  & 
Marton,  2011),  it  is  assumed  that  the  position  measurements 
in  the  Earth  frame  and  Euler  angles  measurements  are  avail¬ 
able.  For  instance,  these  measurements  can  be  generated  by 
a  camera-based  motion  capture  system,  a  technology  com¬ 
monly  employed  for  in-door  UAV  flight  (Guenard,  Hamel,  & 
Mahony,  2008).  Hence,  the  system  model  can  be  augmented 
by  the  following  output  equations: 
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surements.  Substituting  the  sensor  model  from  Eq  (5)-(6)  into 
the  systems  dynamics  Eq  (l)-(4),  we  obtain: 
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where  T(rj)  is  the  rotation  matrix  relating  angular  rates  to 
Euler  angle  rates  and  is  given  by: 
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In  order  to  eliminate  the  coupling  between  translational  ve¬ 
locity  and  angular  rates  when  the  quadrotor  dynamics  are  rep¬ 
resented  with  velocity  relative  to  the  body  frame,  the  quadro¬ 
tor  dynamics  are  expressed  with  velocity  relative  to  the  earth 
frame.  As  can  be  seen  from  Eq  (10)-(13),  a  bias  in  accelerom¬ 
eter  measurements  affects  only  the  position  and  velocity  states. 
Conversely,  gyroscope  measurements  affect  only  Euler  an¬ 
gles  and  angular  rates  states.  Based  on  this  observation,  it 
follows  naturally  to  also  divide  the  fault  diagnosis  of  these 
two  sensor  faults.  The  proposed  fault  detection,  isolation  and 
estimation  architecture  is  shown  in  Figure  2.  As  can  be  seen, 
two  FDI  estimators  monitor  the  system  for  fault  occurrences 
in  accelerometer  and  gyroscope  measurements.  Once  a  fault 
is  detected  and  isolated,  the  corresponding  nonlinear  adaptive 
estimator  is  activated  for  sensor  bias  estimation  purposes. 


3.1.  Gyroscope  Bias  Diagnostic  Estimator 

As  can  be  seen  from  the  dynamics  of  the  quadrotor,  given  by 
equations  (10)-(13),  the  bias  in  the  gyroscope  measurements 
only  affects  the  attitude  and  rotation  dynamics  given  by  Eq 
(12)-(13).  Since  the  attitude  angles  given  by  the  state  vector 
rj  are  assumed  to  be  measurable  (see  Section  2),  based  on  Eq 
(12)-(13)  and  adaptive  estimation  schemes,  such  as  the  series- 
parallel  model  (Ioannou  &  Sun,  1996),  the  fault  diagnostic 
estimator  for  the  gyroscope  bias  can  be  designed  as  follows: 


The  objective  of  this  research  focuses  on  the  detection,  isola¬ 
tion  and  estimation  of  sensor  bias  in  accelerometer  and  gyro¬ 
scope  measurements. 

3.  Fault  Detection  and  Isolation 

This  section  presents  the  proposed  method  for  detecting  and 
isolating  sensor  faults  in  accelerometer  and  gyroscope  mea- 


ff  =  — A(?)  -  rj)  +  T(ry  A  (14) 

where  fj  G  M3  are  the  Euler  angle  estimates,  A  G  M3x3  and 
T  G  M3x3  are  positive-definite,  diagonal  design  matrices.  Let 
the  Euler  angle  estimation  error  be  defined  as: 

fj  =  rj  —  t) 
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Figure  2.  Fault  Detection,  Isolation  and  Estimation  Architec¬ 
ture. 


Then,  based  on  Eq  (12)  and  Eq  (14),  we  have: 

fj  =  f]-fj  =  -A fj  -  (16) 

Equation  (16)  guarantees  that  the  Euler  angles  estimation  er¬ 
ror  converges  asymptotically  to  zero  in  the  absence  of  gyro¬ 
scope  sensor  bias.  In  addition,  in  the  presence  of  a  non-zero 
bias  bu,  based  on  Eq  (16)  it  can  be  seen  that  the  residual  fj 
will  deviate  from  zero.  Therefore,  if  any  component  of  the 
state  estimation  error  fj  is  significantly  different  from  zero, 
we  can  conclude  that  a  fault  in  the  gyroscope  measurements 
has  occurred. 


3.2.  Accelerometer  Bias  Diagnostic  Estimator 

The  dynamics  of  UAV  position  and  velocity  relative  to  the 
inertial  frame  given  by  Eq  (10)  and  Eq  (1 1)  can  be  put  in  the 
following  state  space  model: 

x  =  Ax  +  f(rj ,  ya)  +  Ga(r])ba 
y  =  Cx  (  j 
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and  C  =  [Is,  O3X3],  where  Is  is  a  3  x  3  identity  matrix,  03x3 
is  a  3  x  3  matrix  with  all  entries  zero  and  03Xi  is  a  3  x  1 
zero  vector.  Based  on  this  configuration,  the  following  fault 


diagnostic  observer  is  chosen  : 

x  =  Ax  +  f(rj ,  ya)  +  L(y  -  y) 
y  =  Cx 


(18) 


where  x  G  M6  represents  the  inertial  position  and  velocity 
estimation,  y  G  M3  are  the  predicted  position  outputs,  and 
L  is  a  design  matrix  chosen  such  that  the  matrix  A  =  (A  — 
LC )  is  stable.  From  the  definition  of  matrices  A  and  C  given 
by  Eq  (17)  it  is  straightforward  to  show  that  the  system  is 
observable.  Therfore,  the  matrix  L  can  be  easily  designed. 
Defining  the  state  estimation  error  as:  x  =  x  —  x  and  the 
quadrotor  position  estimation  error  as  y  =  y  —  y,  it  follows 
that: 

X  =  Ax  +  Ga(ri)ba 

y  =  Cx  . 

Clearly,  the  output  estimation  error  y  reaches  zero  asymptoti¬ 
cally  in  the  absence  of  the  accelerometer  bias  ba .  Furthermore 
it  can  be  seen  from  Eq  (19)  the  residual  y  is  only  sensitive  to 
the  bias  ba.  Therefore,  if  any  component  of  the  position  esti¬ 
mation  error  y  deviates  significantly  from  zero,  we  can  con¬ 
clude  that  a  fault  in  the  accelerometer  sensor  measurement 
has  occurred. 


3.3.  Fault  Detection  and  Isolation  Decision  Scheme 

As  described  in  section  3.1  and  3.2,  the  two  fault  diagnostic 
estimators  are  designed  such  that  each  of  them  is  only  sensi¬ 
tive  to  one  type  of  sensor  faults.  Based  on  this  observation, 
the  residuals  fj  and  y  generated  by  Eq  (16)  and  Eq  (19)  can 
also  be  used  as  structured  residuals  for  fault  isolation.  More 
specifically,  we  have  the  following  fault  detection  and  isola¬ 
tion  decision  scheme: 

•  In  the  absence  of  any  faults,  all  components  of  the  resid¬ 
uals  fj  and  y  should  be  close  to  zero. 

•  If  all  components  of  the  residual  fj  remain  around  zero, 
and  at  least  one  component  of  the  residual  y  is  signifi¬ 
cantly  different  from  zero,  then  we  conclude  that  an  ac¬ 
celerometer  fault  has  occurred. 

•  If  all  components  of  the  residual  y  remain  around  zero, 
and  at  least  one  component  of  the  residual  fj  is  signifi¬ 
cantly  different  from  zero,  then  we  conclude  that  a  gyro¬ 
scope  fault  has  occurred. 

•  If  at  least  one  component  of  the  residual  fj  is  significantly 
different  from  zero,  and  at  least  one  component  of  the 
residuals  y  is  significantly  different  from  zero,  then  we 
conclude  that  both  a  gyroscope  and  accelerometer  sensor 
measurement  fault  has  occurred. 

The  above  FDI  decision  scheme  is  summarized  in  Table  1, 
where  “0”  represents  nearly  zero  residuals,  and  “1”  represents 
significantly  large  residuals. 
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Table  1.  Fault  Isolation  Decision  Truth  Table. 


No  Fault 

Gyro  Bias 

Accel  Bias 

Accel  &  Gyro 
Bias 

7j 

0 

0 

1 

1 

y 

0 

1 

0 

1 

4.  Fault  Estimation 

After  a  sensor  fault  is  detected  and  isolated,  it  is  also  cru¬ 
cial  to  provide  an  estimation  of  the  sensor  bias  to  improve 
the  performance  of  the  closed  loop  control  system.  As  shown 
in  Figure  2,  once  a  fault  has  been  detected  and  isolated,  the 
corresponding  nonlinear  adaptive  bias  estimator  is  activated 
with  the  purpose  of  estimating  the  fault  magnitude  in  the  ac¬ 
celerometer  and/or  gyroscope  measurements.  In  this  section, 
we  describe  the  design  of  nonlinear  adaptive  estimators  for 
sensor  bias  estimation. 

4.1.  Accelerometer  Fault  Estimation 

Based  on  Eq  (17),  the  adaptive  observer  for  estimating  the 
accelerometer  bias  magnitude  is  chosen  as: 

x  =  Ax  +  fiv,  2/a)  +  L(y  -y)  +  Ga(ri)ba  +  Clba  (20) 

n  =  {A- LC)Q  +  Ga{v)  (21) 

y  =  Cx  (22) 

where  x  is  the  estimated  position  and  velocity  vector,  y  is  the 
estimated  position  output,  ba  is  the  estimated  sensor  bias,  and 
L  is  the  observer  gain  matrix.  The  adaptation  in  the  above 
adaptive  estimator  arises  due  to  the  unknown  bias  ba.  The 
adaptive  law  for  updating  ba  is  derived  using  Lyapunov  syn¬ 
thesis  approach  (Ioannou  &  Sun,  1996;  Zhang,  2011).  Specif¬ 
ically,  the  adaptive  algorithm  is  given  by: 

'ba  =  mTCTya  (23) 

where  T  >  0  is  a  symmetric  and  positive-definite  learning 
rate  matrix,  and  ya  =  ya  —  ya  is  the  output  estimation  error. 
Let  us  also  define  the  state  estimation  error  x  =  x  —  x.  Then, 
based  on  Eq  (17)  and  Eq  (20),  the  dynamics  governing  the 
state  estimation  error  are  given  by: 

x  =  Ax  -  Ga(<f>,  0 ,  2p)ba  -  f 1ba  (24) 

where  A  =  A  —  LC  and  ba  =  ba  —  ba  is  the  parameter 
estimation  error.  By  substituting  Ga(rj)  =  Q  —  (A  —  LC)Q 
(see  Eq  (21))  into  Eq  (24),  we  have 

x  =  Ax  —  (Cl  —  AQ)ba  —  Qba 
=  A(x  +  tiba)  —  tlba  —  tiba  . 


By  defining  x  =  x-\-Clba,  the  above  equation  can  be  rewritten 
as 

x  =  Ax  .  (26) 

In  addition,  the  adaptive  parameter  estimation  algorithm  (see 
Eq  (23))  can  be  rewritten  as: 

ba  =  r  nTcTya 
=  rnTcTCx 

=  rnTcTc(x  -  nia).  (27) 

Because  the  bias  ba  is  constant,  we  have  ba  =  ba.  Thus,  Eq 
(27)  can  be  rewritten  as: 

ba  =  rnTcTCx  -  rnTcTcnba.  (28) 

Based  on  Eq  (26),  we  know  x  converges  asymptotically  to 
zero,  since  A  is  stable  by  design.  In  addition,  if  there  exists 
constants  Go  >  0,  T0  >  0  and  a\  such  that  the  following 
condition  is  satisfied: 

i  rt+T0 

ol\I  >  —  flTCTCfldr  >  Go  I  (29) 
-M3  Jt 

then  we  can  conclude  that  the  ba  will  converge  to  zero,  that 
is  ba  converges  to  the  actual  value  ba.  It  is  worth  noting 
that  the  condition  given  by  Eq  (29)  provides  the  required  per¬ 
sistence  of  excitation  for  parameter  convergence  (Ioannou  & 
Sun,  1996).  The  nature  of  UAV  flight  provides  vibrations  in 
practical  applications,  which  may  lead  to  adequate  levels  of 
excitation.  In  addition,  this  condition  can  be  satisfied  by  com¬ 
manding  the  UAV  to  perform  certain  maneuvers. 

4.2.  Gyroscope  Fault  Estimation 

Based  on  Eq  (12),  after  the  presence  of  a  gyroscope  bias  fault 
is  detected,  the  following  adaptive  estimator  is  activated  in 
order  to  estimate  the  bias  in  the  gyroscope  sensor: 

rj  =  -A(fj-T))  +T(rj)yu  -T(rj)bu  (30) 

=  l7'(7/)(//  //)  (31) 

where  fj  is  the  Euler  angle  estimate,  bu  represents  the  estima¬ 
tion  of  the  sensor  bias,  A  and  T  are  positive  definite  design 
matrices.  The  adaptive  law  for  estimating  the  bias  in  gyro¬ 
scope  measurements  in  Eq  (31)  is  derived  using  Lyapunov 
synthesis  approach  (Ioannou  &  Sun,  1996).  The  adaptive 
scheme  in  Eq.  (30)  ensures  that  the  attitude  angle  estimation 
error  rj  =  rj  —  fj  converges  asymptotically  to  zero.  In  addition, 
in  order  to  ensure  parameter  convergence,  T(rj)  will  also  have 
to  satisfy  the  persistence  of  excitation  condition  (Ioannou  & 
Sun,  1996),  that  is: 

i  rt+To 

ai I  >  =-  /  T(r))TT(r])dT  >  a0I  (32) 

2o  Jt 
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for  some  constants  a±  >  Go  >  0  and  To  >  0  and  for  all 
t  >  0.  Again,  we  note  that  vibration  present  in  UAV  flight 
may  offer  adequate  excitation.  Additionally,  the  UAV  can  be 
commanded  to  perform  certain  maneuvers  in  order  to  reach 
the  required  levels  of  persistence  of  excitation. 

5.  Simulation  Results 

In  this  section,  we  present  some  simulation  results  in  order 
to  illustrate  the  effectiveness  of  the  proposed  sensor  bias  di¬ 
agnosis  method.  Specifically,  two  cases  are  studied  while  the 
quadrotor  is  commanded  to  move  along  a  circular  trajectory 
with  a  radius  of  4  meters  for  a  period  of  20  seconds.  We  con¬ 
trol  the  position  and  yaw  rate  of  the  quadrotor  by  means  of 
state  feedback  using  a  linear  quadratic  regulator.  As  previ¬ 
ously  shown,  the  fault  diagnosis  technique  employed  in  this 
approach  is  independent  of  the  structure  of  the  controller. 
Therefore,  for  brevity,  the  discussion  on  the  control  design 
is  purposely  omitted. 

The  first  case  studied  corresponds  to  a  bias  drift  in  accelerom¬ 
eter  measurements.  Specifically,  at  time  t  =  1  Os  we  in¬ 
jected  a  constant  bias  of  ba  =  [0.2,  0.1,  0.5]Tm/s2  in  the 
accelerometer  measurements.  Figure  3  shows  the  FDI  resid¬ 
uals  generated  by  the  two  diagnostic  estimators  described  by 
Eq  (14)  and  Eq  (18),  respectively.  As  can  be  seen,  the  compo¬ 
nents  of  the  residual  generated  by  the  estimator  correspond¬ 
ing  to  the  accelerometer  bias  fault  become  nonzero  shortly 
after  fault  occurrence,  while  all  residual  components  gener¬ 
ated  by  the  gyroscope  fault  diagnostic  estimator  remain  zero. 
Based  on  the  detection  and  isolation  logic  given  in  Table  1, 
we  can  conclude  that  a  fault  has  occurred  in  the  accelerome¬ 
ter  measurement.  In  addition,  Figure  4  shows  the  estimation 
of  the  bias  in  the  accelerometer  for  each  axis,  respectively, 
provided  by  the  adaptive  estimator  (see  Eq  (23)).  As  can  be 
seen,  the  bias  estimate  correctly  reaches  the  actual  bias  values 
in  the  accelerometer  measurements. 

The  second  case  corresponds  to  a  bias  in  the  gyroscope  mea¬ 
surements  injected  at  time  t  =  10s.  The  bias  magnitude  con¬ 
sidered  is  given  by  =  [10°,  5°,  1°]T.  Figure  5  shows 
the  time  behaviors  of  the  residuals  generated  by  the  two  di- 
agnositc  estimators.  As  can  be  seen,  the  FDI  residuals  gen¬ 
erated  by  the  diagnostic  estimator  corresponding  to  the  gy¬ 
roscope  fault  become  nonzero  shortly  after  fault  occurrence, 
and  the  residuals  generated  by  the  estimate  corresponding  to 
accelerometer  fault  always  remain  zero.  Therefore,  based  on 
the  detection  and  isolation  decision  logic  given  in  Table  1 ,  we 
can  conclude  that  a  fault  has  occurred  in  gyroscope  measure¬ 
ments.  Figure  6  shows  the  estimate  of  the  bias  in  gyroscope 
roll,  pitch  and  yaw  measurements.  As  it  can  be  seen,  the  bias 
estimate  reaches  the  actual  values  of  the  bias  in  the  sensor. 


(a)  Residuals  generated  by  the  diagnostic  estimator  corresponding 
to  accelerometer  bias 


(b)  Residuals  generated  by  the  diagnostic  estimator  corresponding 
to  gyroscope  bias 

Figure  3.  Fault  detection  and  isolation  of  accelerometer  bias. 


Figure  4.  Estimation  of  accelerometer  bias 
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(a)  Residuals  generated  by  the  diagnostic  estimator  corresponding 
to  accelerometer  bias 


(b)  Residuals  generated  by  the  diagnostic  estimator  corresponding 
to  accelerometer  bias 

Figure  5.  Fault  detection  and  isolation  of  gyroscope  bias. 


Figure  6.  Estimation  of  gyroscope  bias 


6.  Conclusion  and  Future  Work 

In  this  paper,  we  present  the  design  of  a  nonlinear  fault  di¬ 
agnostic  method  for  sensor  bias  faults  in  accelerometer  and 
gyroscope  measurements  of  quadrotor  UAVs.  Based  on  the 
idea  that  accelerometer  and  gyroscope  measurements  coin¬ 
cide  with  translational  and  rotational  forces  acting  on  the  body, 
respectively,  two  FDI  estimators  are  designed  to  generate  struc¬ 
tured  residuals  for  fault  detection  and  isolation.  In  addition, 
nonlinear  adaptive  estimation  estimation  schemes  are  presented 
to  provide  an  estimate  of  the  sensor  bias.  The  effectiveness  of 
the  proposed  method  is  illustrated  through  simulation  exam¬ 
ples. 

In  this  paper  we  assumed  that  Euler  angles  are  available  di¬ 
rectly  for  FDI  design  (for  instance,  from  a  motion  capture 
camera  system).  In  some  real-world  applications,  this  as¬ 
sumption  may  not  be  satisfied.  Therefore,  the  consideration 
of  attitude  angle  estimation  as  well  as  investigation  of  actua¬ 
tor  faults  is  a  direction  for  future  research.  In  addition,  further 
evaluation  of  the  sensor  bias  fault  diagnostic  method  through 
experimental  studies  with  noisy  measurements  will  be  con¬ 
ducted. 
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